/* USER CODE BEGIN Header */
/**
  ******************************************************************************
  * File Name          : freertos.c
  * Description        : Code for freertos applications
  ******************************************************************************
  * @attention
  *
  * <h2><center>&copy; Copyright (c) 2021 STMicroelectronics.
  * All rights reserved.</center></h2>
  *
  * This software component is licensed by ST under Ultimate Liberty license
  * SLA0044, the "License"; You may not use this file except in compliance with
  * the License. You may obtain a copy of the License at:
  *                             www.st.com/SLA0044
  *
  ******************************************************************************
  */
/* USER CODE END Header */

/* Includes ------------------------------------------------------------------*/
#include "FreeRTOS.h"
#include "task.h"
#include "main.h"
#include "cmsis_os.h"

/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */     
#include "oslib.h"
#include "ctrl_protocol.h"
/* USER CODE END Includes */

/* Private typedef -----------------------------------------------------------*/
/* USER CODE BEGIN PTD */

/* USER CODE END PTD */

/* Private define ------------------------------------------------------------*/
/* USER CODE BEGIN PD */

/* USER CODE END PD */

/* Private macro -------------------------------------------------------------*/
/* USER CODE BEGIN PM */

/* USER CODE END PM */

/* Private variables ---------------------------------------------------------*/
/* USER CODE BEGIN Variables */

/* USER CODE END Variables */
/* Definitions for defaultTask */
osThreadId_t defaultTaskHandle;
const osThreadAttr_t defaultTask_attributes = {
  .name = "defaultTask",
  .priority = (osPriority_t) osPriorityNormal,
  .stack_size = 64 * 4
};
/* Definitions for CtrlTask */
osThreadId_t CtrlTaskHandle;
const osThreadAttr_t CtrlTask_attributes = {
  .name = "CtrlTask",
  .priority = (osPriority_t) osPriorityAboveNormal,
  .stack_size = 128 * 4
};
/* Definitions for SendTask */
osThreadId_t SendTaskHandle;
const osThreadAttr_t SendTask_attributes = {
  .name = "SendTask",
  .priority = (osPriority_t) osPriorityBelowNormal,
  .stack_size = 128 * 4
};
/* Definitions for RecvTask */
osThreadId_t RecvTaskHandle;
const osThreadAttr_t RecvTask_attributes = {
  .name = "RecvTask",
  .priority = (osPriority_t) osPriorityBelowNormal1,
  .stack_size = 64 * 4
};
/* Definitions for DispTask */
osThreadId_t DispTaskHandle;
const osThreadAttr_t DispTask_attributes = {
  .name = "DispTask",
  .priority = (osPriority_t) osPriorityLow,
  .stack_size = 64 * 4
};
/* Definitions for DataTask */
osThreadId_t DataTaskHandle;
const osThreadAttr_t DataTask_attributes = {
  .name = "DataTask",
  .priority = (osPriority_t) osPriorityNormal,
  .stack_size = 128 * 4
};
/* Definitions for CtrlSendQueue */
osMessageQueueId_t CtrlSendQueueHandle;
const osMessageQueueAttr_t CtrlSendQueue_attributes = {
  .name = "CtrlSendQueue"
};
/* Definitions for CtrlRecvQueue */
osMessageQueueId_t CtrlRecvQueueHandle;
const osMessageQueueAttr_t CtrlRecvQueue_attributes = {
  .name = "CtrlRecvQueue"
};
/* Definitions for CtrlDispQueue */
osMessageQueueId_t CtrlDispQueueHandle;
const osMessageQueueAttr_t CtrlDispQueue_attributes = {
  .name = "CtrlDispQueue"
};

/* Private function prototypes -----------------------------------------------*/
/* USER CODE BEGIN FunctionPrototypes */
   
/* USER CODE END FunctionPrototypes */

void StartDefaultTask(void *argument);
extern void _CtrlTask(void *argument);
extern void _SendTask(void *argument);
extern void _RecvTask(void *argument);
void _DispTask(void *argument);
extern void _DataTask(void *argument);

void MX_FREERTOS_Init(void); /* (MISRA C 2004 rule 8.1) */

/**
  * @brief  FreeRTOS initialization
  * @param  None
  * @retval None
  */
void MX_FREERTOS_Init(void) {
  /* USER CODE BEGIN Init */
       OSLIB_Init();
  /* USER CODE END Init */

  /* USER CODE BEGIN RTOS_MUTEX */
  /* add mutexes, ... */
  /* USER CODE END RTOS_MUTEX */

  /* USER CODE BEGIN RTOS_SEMAPHORES */
  /* add semaphores, ... */
  /* USER CODE END RTOS_SEMAPHORES */

  /* USER CODE BEGIN RTOS_TIMERS */
  /* start timers, add new ones, ... */
  /* USER CODE END RTOS_TIMERS */

  /* Create the queue(s) */
  /* creation of CtrlSendQueue */
  CtrlSendQueueHandle = osMessageQueueNew (8, sizeof(Ctrl_Prot_t), &CtrlSendQueue_attributes);

  /* creation of CtrlRecvQueue */
  CtrlRecvQueueHandle = osMessageQueueNew (4, sizeof(void *), &CtrlRecvQueue_attributes);

  /* creation of CtrlDispQueue */
  CtrlDispQueueHandle = osMessageQueueNew (4, sizeof(uint8_t), &CtrlDispQueue_attributes);

  /* USER CODE BEGIN RTOS_QUEUES */
  /* add queues, ... */
  /* USER CODE END RTOS_QUEUES */

  /* Create the thread(s) */
  /* creation of defaultTask */
  defaultTaskHandle = osThreadNew(StartDefaultTask, NULL, &defaultTask_attributes);

  /* creation of CtrlTask */
  CtrlTaskHandle = osThreadNew(_CtrlTask, NULL, &CtrlTask_attributes);

  /* creation of SendTask */
  SendTaskHandle = osThreadNew(_SendTask, NULL, &SendTask_attributes);

  /* creation of RecvTask */
  RecvTaskHandle = osThreadNew(_RecvTask, NULL, &RecvTask_attributes);

  /* creation of DispTask */
  DispTaskHandle = osThreadNew(_DispTask, NULL, &DispTask_attributes);

  /* creation of DataTask */
  DataTaskHandle = osThreadNew(_DataTask, NULL, &DataTask_attributes);

  /* USER CODE BEGIN RTOS_THREADS */
  /* add threads, ... */
  /* USER CODE END RTOS_THREADS */

}

/* USER CODE BEGIN Header_StartDefaultTask */
/**
  * @brief  Function implementing the defaultTask thread.
  * @param  argument: Not used 
  * @retval None
  */
/* USER CODE END Header_StartDefaultTask */
void StartDefaultTask(void *argument)
{
  /* USER CODE BEGIN StartDefaultTask */
  /* Infinite loop */
  for(;;)
  {
    osDelay(1);
  }
  /* USER CODE END StartDefaultTask */
}

/* USER CODE BEGIN Header__DispTask */
/**
* @brief Function implementing the DispTask thread.
* @param argument: Not used
* @retval None
*/
/* USER CODE END Header__DispTask */
__weak void _DispTask(void *argument)
{
  /* USER CODE BEGIN _DispTask */
  /* Infinite loop */
  for(;;)
  {
    osDelay(1);
  }
  /* USER CODE END _DispTask */
}

/* Private application code --------------------------------------------------*/
/* USER CODE BEGIN Application */
     
/* USER CODE END Application */

/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
